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ABSTRACT 

This paper develops the forward and inverse position kinematics of the ARID 
manipulator and also its forward velocity kinematics. 
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1. INTRODUCTION 

The kinematic structure of the ARID manipulator lends itself to simple forward 
and inverse kinematics analysis. The purpose of this paper is to fully document 
and verify an existing analysis. The symbolic software package MATHEMATIC A 
was used to produced and verify the equations presented here. In the analysis to 
follow, the standard Devenit-Hartenberg kinematic parameters of the ARID were 
employed. 


2. ARID FORWARD KINEMATICS 

Table 2. 1 lists the Devenit-Hartenberg kinematic parameters for the ARID robot. 


Table 2.1 : Kinematic Parameters for the ARID Robot 
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Table 2.2 lists the nominal values of the link lengths and the fixed angle The 

distance 1 + a 4 computes the tool -end-point along the *-axis of the tool-frame 
whose origin is located at the flange. 


From the DH-parameters of the ARID robot listed in Table 2.1, the four link 
transforms compute to 
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Table 2.2 Nominal Values of ARID Kinematic Parameters 


Parameter 

Theoretical Value 

Measured Value 

Units 

a i 

V 66.37 2 + 48.28 2 
= 82.0727 

82.3 

inches 

a 2 

45.00 

45 

inches 

a 3 

35.00 

35 

inches 

l + a4 


35.75 

inches 

Si 

48 ' 28 = 0.588259 

a i 



Cl 

6637 =0.808673 

a i 



e, 

36.0335° 

35.2053° 

Degrees 


The forward kinematics transform of the ARID equals 

°T 4 = Lj L2 L3 L4 (2-2) 

which reduces to 
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(2-3) 


If the ARID axes are not parallel, this model will produce erroneous results. A 
second paper will address the development of a error-model for the ARID 
kinematics. 

3. ARID END FRAME JACOBIAN 


The Jacobian of the ARID relates the joint-rates q = [ di 02 03 04 ] T to the 

frame-velocity V = [\ T co T ] T of the end-frame, 


V = Jq. 


The Jacobian of the ARID computes to 
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(3-1) 
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The leading superscript 4 means that this Jacobian is expressed in frame F 4 
while the 0 indicates the motion is that of the end-frame relative to the base 
frame Fq of the ARID. 
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The tool-center-point vector (tcp), expressed in the end-effector-frame F 4 for 
this robot, equals, by definition, 

4 tcp = [24 inches 0 0 ] T = 24 x. (3-3) 

Hence, the base-frame expression of the tool-center-point vector equals 

M- H M- (3 - 4) 

The ARID base-frame expression of the tcp position, therefore, equals 

°tcp = p + R 4 tcp. (3-5) 

The ARID base-frame velocity of the tcp, therefore, equals 

v tcp = p + co x R 4 tcp = R( 4 -°v 4 + 4 «°cd 4 X24 x) , (3-6) 


where 


4 -°V 4 = 


4 -°v 4 

4 -°co 4 


4 °J 4 q. 


(3-7) 


In general, the middle expression in (3-6) can be used to compute the velocity of 
any point fixed in the end-frame F 4 . 


4. ARID INVERSE POSE KINEMATICS 

Specify the pose of the end-effector frame at the ARID flange by the 
homogeneous matrix H, 
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where p = [p* p y p z ] T is the position of the flange center-point and 
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(4-2) 


is the rotation matrix that rotates the base-frame of the robot into a frame 
parallel to the tool-frame. Equivalently, R transforms a vector expressed in the 
end-effector-frame coordinates into the same vector expressed in the robot base- 
frame coordinates. The inverse position kinematics problem is to solve for the 
joint variables given H. This means solving the matrix equation 

°T 4 = H (4-3) 


Solving for the Sum of the Three Revolute Joint Angles 

Unless R a rotation about the z-axis , t z = 1, no joint variable set will satisfy 
(4-3). Given that tz= 1, °T 4 [i,i] = H[i,i] , °T 4 [ 2 ,i] = H[ 2 ,i] implies 

c i234 - n x ar) d s 12 3 4 = iiy . (4-4) 

\ «F “'t .... . ... * 

j? f ' • • ' -■ : “ 

Hence, 

0 2 + 03 + 0 4 = atan2[ n y , n x ] - 0j. (4-5) 

The known value of 0j in Table 2.2 provides the additional information to 
compute the sum of the last three joint angles. 
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Solving for the Prismatic Displacement of Joint One 

The value of the prismatic joint follows immediately from °T 4 [3,4] = H[3,4], 

Pz = <*i. < 4-6 ) 

Next, we solve for 63 . 

Solving for the Angle of Joint Three 

Define the known, translated position vector p = [p x p y p z ] T , 

p x p x — ai Ci , Py := Py — aj Sj, and Pz := Pz . ( 4 - 7 ) 

The equalities °T 4 [i,4] = H(i,4] and °T 4 [2,4] = H[2,4] imply 


Px = a 3 c 123 + a 2 C I 2 


(4-8) 


Py = a 3 s 123 + a 2 s 12 


(4-9) 


The previous two equations constitute the well-known elbow equations. Squaring 
both equations and adding yields the kinematic equation 
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(4-10) 


which has two solutions, 


0 3 = ±atan2[ 



» ] , 


(4-11) 


or, equivalently, 
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as long as the constraint 
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or, equivalently, 


is satisfied. 
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(4-13) 


(4-14) 


Equation (4-14) expresses the geometric constraints that the manipulator cannot 
reach out past the sum of its link lengths and no closer than the difference. The 
reachable work space, is contained in an envelope consisting of an annular ring 
with inner radius of la 2 - a 3 l and outer radius of a 2 + a 3 . When the end-point is 
on the inner radius, cos 63 = -1 and on the outer boundary, cos 63 = 1 . On 
these boundaries there is only one solution for cos 0 3 in (4-12). The constraints 
on prevents the ARID robot from reaching either the inner or outer 
boundaries. No position in the ARID work space violates either conditions. In the 
workspace on the orbiter, only the positive solution 63 > 0 is considered. 

Solving for the Angle of Joint Two 

With joint angle 63 determined, 0 2 can be computed from (4-8) and (4-9) by 
expanding the trigonometric terms using the sum of angles formulas and 
collecting the S 2 and ci terms to form the simultaneous equations: 
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a 2 + a 3 -c 3 a 3 s 3 
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(4-15) 


Relation (4-15) is a linear algebraic system of equations in s 2 and c 2 Solutions 
exist to (4-15) provided the determinant of the matrix is non-zero, 


-a 3 s 3 a 2 + a 3 -c 3 
a 2 + a 3 'C 3 a 3‘ s 3 


= -[a 2 + a 3 - 2a 2 a3 cos(rc-03) ] = -[ Px + Py ] * 0 
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Thus, as long as the position vector p of the end-frame has at least one of its 
planar components non-zero, Px + Py * 0, the system of equations (4-15) is 


invertible, 
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r a 3-s 3 

-a 2 - a 3’ c 3 
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88 ~2 ~2 
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LPyJ 


(4-16) 


2 2 • 

One cannot be sure that (4-16) is valid unless, s 2 + c 2 = 1 • This constraint can be 

proven to be satisfied whenever a solution to 9$ exists. Finally, to obtain 02, 
compute 


02 = atan2 [-a 3 S 3 px + (a 2 + a 3 , C3)'Py* ( a 2 + a 3* c 3)‘Px + a 3'S 3 'Py 1 • (4-17) 

Each value of 63 in (4-17) determines a unique value of $2>* In the ARID robot 
only the positive solution for 63 is used, hence, only one value of 62 requires 
computing. 

ARID Robot Inverse Pose Kinematic Summary 

Table 4.1 summarizes the inverse kinematics analysis for the ARID robot. The 
first column supplies the equations needed to solve for the joint variables in terms 
of the configuration variables and the DH-parameters. The second column states 
the natural kinematic constr aints which must be satisfied in order for the solution 
to be valid. Natural kinematic constraints indicate geometric relationships 
between and amongst the DH-parameters and configuration variables that must be 
satisfied, independent of joint range limits or link interference. For purposes of 
theoretical analysis, therefore, joint variables range over all the real numbers. In 
the ARID, for example, the solution dj = p z is always theoretically valid, even 
though the solution is not realizable when p : exceeds the physical length of the 
robot track. The inverse solutions to the ARID manipulator that satisfy the 
natural kinematic constraints must be checked to determine if the computed 
values of the joint variables fall within the physical joint limits dictated for the 
ARID. Those solutions which do satisfy the joint limits are said to be realizable 
by the manipulator. Refer to Table 2.2 for joint limits of the ARID robot. 
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Table 4. 1 Inverse Solution to the ARID Manipulator 


Joint Variable Solution 

Theoretical Kinematic Constraints for 
Solution 

dl=Ez 

None 

r ~2 ~2 2 2 1 

Px + Py ~ 3 2 ~ a 3 

A _ri rn j-iL 1 

(a 2 - a 3 ) 2 < px + Py £ (a 2 + a 3 ) 2 

U3 = ±COS 1 

J L 2-a2-a3 J 

02 = atan2 [-a 3 s 3 p x + ( a 2 + a 3 -c 3 )-p y , 
(a 2 + a 3 • c 3 ) • p x + a 3 s 3 p v ] 

(a 2 - a 3 ) 2 < Px + py ^ (a 2 + a 3 ) 2 

04 = atan2 [n y , n x ] - (01 + 02 + 03 ) 

t Z = 1 


5. CONCLUSION 

The nominal ARID forward position and velocity kinematics have been 
developed, as well as the forward velocity kinematics. A follow-up paper will 
develop a kinematics error-model for calibrating the ARID. 
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